LabVIEW Arduino無線藍牙遙控智能車(項目篇—2)
1
項目概述
智能小車是以輪子作為移動機構,并且能夠實現自主行駛的機器人,又被稱為輪式機器人。由于具有智能化的特點,可以應用于不適合人類工作的環境中,例如災難救援、戶外探險等。智能小車有別于遙控小車,因為后者需要操作人員來控制其轉向、啟停和前進后退,以及控制其速度,常見的模型小車,都屬于這類遙控車。智能小車,則可以通過計算機編程來實現其對行駛方向、啟停以及速度的控制,無須人工干預,也可以通過修改智能小車的程序來改變它的行駛方式。
智能小車的典型特點有:
1、擁有至少一個微控制器,通過微控制器來實現對行駛方向、啟停和速度的控制。
2、擁有多個各種功能的傳感器,以獲取外界環境的情況,以供控制器做出準確的決策。
2
項目架構
本節將要介紹一種基于Arduino與LabVIEW的無線遙控智能小車,可以實現自主(巡線和避障)與遙控兩種功能,并且可以在兩種功能之間進行切換。智能小車采用Arduino作為控制核心,上位機軟件采用LabVIEW,兩者通過APC220無線數傳模塊實現無線通信。無線遙控智能小車總體框圖如下圖所示:
智能小車的車體采用兩個驅動輪、一個萬向輪的三輪式小車模型,驅動電機采用直流減速電機,電機驅動模塊采用VNH2SP30模塊,循跡傳感器采用OPENJUMPER紅外巡線傳感器OJ-CG307,避障傳感器采用OPENJUMPER紅外避障傳感器OJ-CG303。
智能小車的巡線場地為白底黑線,線寬約10mm,場地大小約為200cm×300cm。
3
傳感器和控制器
3.1、傳感器
本節介紹的無線遙控智能小車,可以實現自主與遙控兩種功能,并且可以在兩種功能之間進行切換。當小車處于遙控狀態時,操作者通過操作LabVIEW上位機軟件,利用APC220串口無線模塊向小車上的Arduino控制器發送遙控指令,從而使小車做出指定的行為動作。而當小車處于自主狀態時候,小車上的Arduino控制器通過四個紅外巡線傳感器和一個紅外避障傳感器獲取小車相對于黑線的位置和前面是否有障礙物的信號,并根據程序中設置的邏輯來控制直流減速電機,以實現巡線和避障的功能。
紅外巡線傳感器模塊是利用紅外對管檢測模塊本身發出的紅外線的反射光(深色反射弱,淺色反射強),來為循跡機器人提供白線或者黑線的跟蹤,既可以檢測白底中的黑線,也可以檢測黑底中的白線,若檢測到白線則輸出高電平,若檢測到黑線則輸出低電平。
紅外避障傳感器****紅外線并根據反射回來的紅外光判斷前方是否存在障礙物,無障礙物時輸出高電平,有障礙時輸出低電平,在信號輸出同時有指示燈指示狀態,無障礙物時LED為綠,有障礙物時為紅。同時內置38kHz的信號發生器,抗干擾能力強。通過調節模塊上的2KΩ電位器,可以調節傳感器的探測距離。
紅外巡線傳感器模塊如下圖所示:
紅外避障傳感器模塊如下圖所示:
3.2、控制器
一般情況下,直流電機需要很大的驅動電流,而像Arduino之類的控制器輸出的邏輯電平無法直接驅動直流電機,特別是大功率的減速電機,所以就需要通過驅動器件給直流電機提供工作電流。
Arduino愛好者常用的直流電機驅動模塊主要有L298模塊和VNH2SP30模塊。
L298電機驅動模塊價格較為便宜,而且單個L298芯片可以同時驅動兩路直流電機,所以在Arduino愛好者制作機器人小車時使用較多,但是其轉化效率較低,發熱量較大,不適合驅動大電流直流電機,當驅動大電流電機時容易發生芯片"假死"等故障。
VNH2SP30模塊具有驅動電流大、轉換效率高等優點但是單個VNH2SP30芯片只能驅動一路直流電機,如果驅動兩路直流電機則需要兩個VNH2SP30芯片。
為了使得遙控智能小車具有良好的動力系統,具有一定的載重能力,此處選用直流減速電機作為整個遙控智能小車的動力來源,并選用顆粒輪胎,以提高抓地能力。
4
硬件環境
將兩個直流減速電機的兩端分別接至VNH2SP30電機驅動模塊上的OUT1A、OUT1B和OUT2A、OUT2B,無正負極和電機轉向之分。若電機轉向相反,則在調試過程中將電機的連接線對調連接。將VNH2SP30電機驅動模塊的+5V (IN)、GND分別接至Arduino Uno控制板上的+5V、GND,為電機驅動模塊提供工作電壓。
將VNH2SP30電機驅動模塊的1INA、1INB、1PWM分別接至Arduino Uno控制板上的數字端口D7、D6、D5,為電機1提供轉向和調速控制信號;將VNH2SP30電機驅動模塊的2INA、2INB、2PWM分別接至Arduino Uno控制板上的數字端口D4、D2、D3,為電機2提供轉向和調速控制信號。需要注意的是,1PWM和2PWM需要接在具有模擬輸出(PWM)功能的數字端口。
Arduino控制器與驅動及電機部分的硬件連接,如下圖所示:
將一個APC220模塊與Arduino Uno控制板相連接,連接方式如下:
APC220 TXD→Arduino Uno控制板RXD,APC220 RXD→Arduino Uno控制板TXD,APC220 VCC→Arduino Uno控制板5V,APC220 GND→Arduino Uno控制板GND。
將另一塊APC220模塊通過FT232RL轉接板相連接,連接方式如下:
APC220 TXD→FT232RL轉接板RXD,APC220 RXD→FT232RL轉接板TXD,APC220 VCC→FT232RL轉接板5V,APC220 GND→FT232RL轉接板GND。
將四個紅外巡線傳感器依次連接至Arduino Uno控制板的數字端口D8、D9、D10、D11,并在將紅外巡線傳感器安裝至智能小車底盤時,對應于左2、左1、右1和右2。將紅外避障傳感器連接至Arduino Uno控制板的數字端口D12,并將其安裝在小車車頭的前端。
5
Arduino功能設計
4個紅外巡線傳感器在智能小車底盤上的安裝示意圖如下圖所示:
初始狀態為黑線位于左1和右1傳感器之間,表明小車處于黑線中間部分;當左1傳感器檢測到黑線時,表明小車相對于黑線略微偏向右側,需要小幅度左轉以修正偏差;當左2傳感器檢測到黑線時,表明小車相對于黑線偏向右側較多,需要大幅度左轉以修正偏差;當右1傳感器檢測到黑線時,表明小車相對于黑線略微偏向左側,需要小幅度右轉以修正偏差;當右2傳感器檢測到黑線時,表明小車相對于黑線偏向左側較多,需要大幅度右轉以修正偏差。
遙控部分的調速將速度分為5檔,分別為低速、中低速、中速、中高速和高速,通過VNH2SP30電機驅動模塊的PWM輸入信號實現在五檔之間切換與調速。
Arduino Uno控制器程序代碼如下所示:
#define forward_command 0x00 //前進命令#define back_command 0x10 //后退命令#define left_command 0x20 //左轉命令#define right_command 0x30 //右轉命令#define stop_command 0x40 //停止命令 #define speed_1 0x50 //低速命令#define speed_2 0x60 //中低速命令#define speed_3 0x70 //中速命令#define speed_4 0x80 //中高速命令#define speed_5 0x90 //高速命令 byte comdata[3]={0}; //定義數組數據,用于存放串口命令數據int flag = 0; //遙控/自動標志位,默認為遙控模式 int INA1 = 7;int INB1 = 6;int PWM1 = 5; //定義電機1的轉向和速度的控制引腳int INA2 = 4;int INB2 = 2;int PWM2 = 3; //定義電機2的轉向和速度的控制引腳 int Trace_sensor_X1=8;int Trace_sensor_X2=9;int Trace_sensor_Y1=10;int Trace_sensor_Y2=11; //定義四個紅外循跡傳感器的引腳int Avoidance_sensor=12; //定義紅外避障傳感器的引腳 void receive_data(void); //接收串口命令數據void test_do_data(void); //測試串口命令數據是否正確,并執行命令 void forward(void); //前進子函數void back(void); //后退子函數void turn_Left(void); //左轉子函數void turn_Right(void); //右轉子函數void stop_car(void); //停止子函數 void Automatic_mode(void); //自動模式子函數 void setup(){ Serial.begin(9600); //初始化串口波特率為9600 pinMode(INA1, OUTPUT); pinMode(INB1, OUTPUT); pinMode(PWM1, OUTPUT); //設置電機1的控制引腳為輸出狀態 pinMode(INA2, OUTPUT); pinMode(INB2, OUTPUT); pinMode(PWM2, OUTPUT); //設置電機2的控制引腳為輸出狀態 pinMode(Trace_sensor_X1, INPUT); pinMode(Trace_sensor_X2, INPUT); pinMode(Trace_sensor_Y1, INPUT); pinMode(Trace_sensor_Y2, INPUT); //設置紅外循跡傳感器的控制引腳為輸入狀態 pinMode(Avoidance_sensor,INPUT); //設置紅外避障傳感器的控制引腳為輸入狀態 analogWrite(PWM1,150); //left motor analogWrite(PWM2,150); //ringt motor //將電機速度設置為中速檔位} void loop(){ if (Serial.available() > 0) //不斷檢測串口是否有數據 { receive_data(); //從串口緩沖區接收串口命令數據 test_do_data(); //測試串口命令數據是否正確并執行命令 } if(flag==1) //判斷是否為自動模式狀態 { Automatic_mode(); //執行自動模式 analogWrite(PWM1,150); //left motor analogWrite(PWM2,150); //ringt motor //將電機速度切換至中速檔位 }} void receive_data(void) //從串口緩沖區接收串口命令數據{ int i ; for(i=0;i<3;i++) //命令長度為3個字節,每次讀取3個字節 { comdata[i] =Serial.read(); //讀取一個字節的數據 //延時一會,讓串口緩存準備好下一個字節,不延時可能會導致數據丟失, delay(2); }} void test_do_data(void) //測試串口命令數據是否正確并執行命令{ if(comdata[0] == 0x55) //0x55為命令幀頭,判斷幀頭是否正確 { if(comdata[1] == 0xAA) //0xAA為遙控模式命令 { flag=0; //切換至遙控模式 switch (comdata[2]) //匹配遙控模式中的具體命令 { case forward_command: //前進命令 forward(); break; case back_command: //后退命令 back(); break ; case left_command: //左轉命令 turn_Left(); break ; case right_command: //右轉命令 turn_Right(); break ; case stop_command: //停止命令 stop_car(); break ; case speed_1: //低速命令 analogWrite(PWM1,50); analogWrite(PWM2,50); break; case speed_2: //右轉命令 analogWrite(PWM1,100); analogWrite(PWM2,100); break ; case speed_3: //右轉命令 analogWrite(PWM1,150); analogWrite(PWM2,150); break ; case speed_4: //右轉命令 analogWrite(PWM1,200); analogWrite(PWM2,200); break ; case speed_5: //右轉命令 analogWrite(PWM1,250); analogWrite(PWM2,250); break ; } } if(comdata[1] == 0xFF) //0xFF為自主模式命令 { flag=1; //切換至自主模式 comdata[2] = 0; //清空命令數據 } }} void Automatic_mode(void) //自主模式,循跡和避障{ int State_value=0; if(digitalRead(Avoidance_sensor)==0) //避障功能,有障礙物則后退左轉 { back(); delay(1000); turn_Left(); delay(500); } //讀取紅外循跡傳感器組的狀態 State_value=digitalRead(Trace_sensor_X2)*8+digitalRead(Trace_sensor_X1)*4+digitalRead(Trace_sensor_Y1)*2+digitalRead(Trace_sensor_Y2); switch (State_value) //匹配狀態,并調整位置 { case 8: //大幅度偏左,大角度右轉 turn_Right(); delay(200); break; case 4: //小幅度偏左,小角度右轉 turn_Right(); delay(100); break ; case 2: //小幅度偏右,小角度左轉 turn_Left(); delay(100); break ; case 1: //大幅度偏右,大角度左轉 turn_Left(); delay(200); break ; default: //其他狀態,前進 forward(); break; } } void forward(void) //前進{ digitalWrite(INA1, LOW); digitalWrite(INB1, HIGH); digitalWrite(INA2, LOW); digitalWrite(INB2, HIGH); }void back(void) //后退{ digitalWrite(INA1, HIGH); digitalWrite(INB1, LOW); digitalWrite(INA2, HIGH); digitalWrite(INB2, LOW); }void turn_Left(void) //左轉{ digitalWrite(INA1, LOW); digitalWrite(INB1, HIGH); digitalWrite(INA2, HIGH); digitalWrite(INB2, LOW); }void turn_Right(void) //右轉{ digitalWrite(INA1, HIGH); digitalWrite(INB1, LOW); digitalWrite(INA2, LOW); digitalWrite(INB2, HIGH); }void stop_car(void) //停止{ digitalWrite(INA1, LOW); digitalWrite(INB1, LOW); digitalWrite(INA2, LOW); digitalWrite(INB2, LOW); }
6
LabVIEW功能設計
LabVIEW上位機部分需要完成以下功能:
1、當從遙控狀態切換至自主狀態時,向下位機Arduino控制器發送自主狀態命令,Arduino控制器通過讀取紅外巡線傳感器和紅外避障傳感器,以實現巡線和避障的功能。
2、當從自主狀態切換至遙控狀態時,向下位機Arduino控制器發送遙控狀態命令,Arduino控制器通過讀取LabVIEW軟件發來的操作命令,并實現指定的動作和行為,包括前進、后退、左轉、右轉、停止和調速。
6.1、前面板設計
LabVIEW前面板分為遙控模式和模式切換兩個部分,遙控模式部分用于控制小車的運行狀態,包括前進、后退、左轉、右轉、停止和調速;模式選擇部分用于切換遙控模式和自主模式。
無線遙控智能小車的LabVIEW上位機前面板,如下圖所示:
6.2、程序框圖設計
LabVIEW上位機主程序的結構為順序結構+While循環+事件結構。首先,通過設置的串口號來初始化串口通信;然后,程序進入While循環和事件結構,不斷地檢測是否有事件得到響應并執行;事件結構有“模式選項"、“前進”、“后退”、“左轉"、“右轉"、“停止"和“"調速"。最后,關閉串口通信。在程序框圖中,我們需要對串口進行配置,并將根據不同的按鍵按下通過串口發出不同的命令,下位機Arduino Uno收到串口收據,解析出其中的命令代碼后執行相應的命令。
為了更好地實現通信,制定如下的通信協議:幀頭+命令碼+操作碼。0x55為幀頭,0xAA為遙控命令,0xFF為自主命令,遙控命令的操作碼:0x00為前進,0x10為后退,0x20為左轉,0x30為右轉,0x40為停止,0x50為速度檔1,0x60為速度檔2,0x70為速度檔3,0x80為速度檔4,0x90為速度檔5。
在“模式選項”事件中,通過讀取當前選擇的模式,向Arduino控制器分別發送0x55AA和Ox55FF,分別表示切換至遙控模式和自主模式?!澳J竭x項”值改變事件程序框圖如下圖所示:
在“前進"事件中,通過串口向Arduino控制器發送0x55AA00,Arduino控制器將兩個直流減速電機均設置為前進方向?!扒斑M"值改變事件程序框圖如下圖所示:
在“后退"事件中,通過串口向Arduino控制器發送0x55AA10,Arduino控制器將兩個直流減速電機均設置為后退方向?!昂笸?quot;值改變事件程序框圖如下圖所示:
在“左轉"事件中,通過串口向Arduino控制器發送0x55AA20,Arduino控制器將右側電機設置為前進方向、左側電機設置為后退方向,從而實現左轉?!白筠D"值改變事件程序框圖如下圖所示:
在“右轉”事件中,通過串口向Arduino控制器發送0x55AA30,Arduino控制器將右側電機設置為后退方向、左側電機設置為前進方向,從而實現右轉?!坝肄D"值改變事件程序框圖如下圖所示:
均在“停止"事件中,通過串口向Arduino控制器發送0x55AA40,Arduino控制器將左、右兩個電機均設置為停止狀態,從而實現小車的停止?!巴V?quot;值改變事件程序框圖如下圖所示:
在“速度檔位"值改變事件中,通過讀取當前選擇的速度檔位,向Arduino控制器分別發送0x55AA50、0x55AA60、0x55AA70、0x55AA80、0x55AA90,分別表示低速、中低速、中速、中高速和高速?!八俣葯n位"值改變事件的程序框圖如下圖所示:
*博客內容為網友個人發布,僅代表博主個人觀點,如有侵權請聯系工作人員刪除。